home *** CD-ROM | disk | FTP | other *** search
/ Graphics Plus / Graphics Plus.iso / general / modelers / geomview / source.lha / Geomview / src / lib / geometry / transform3 / tm3translate.c < prev    next >
Encoding:
C/C++ Source or Header  |  1993-08-29  |  3.6 KB  |  168 lines
  1. /* Copyright (c) 1992 The Geometry Center; University of Minnesota
  2.    1300 South Second Street;  Minneapolis, MN  55454, USA;
  3.    
  4. This file is part of geomview/OOGL. geomview/OOGL is free software;
  5. you can redistribute it and/or modify it only under the terms given in
  6. the file COPYING, which you should have received along with this file.
  7. This and other related software may be obtained via anonymous ftp from
  8. geom.umn.edu; email: software@geom.umn.edu. */
  9.  
  10. /* Authors: Charlie Gunn, Pat Hanrahan, Stuart Levy, Tamara Munzner, Mark Phillips, Nathaniel Thurston */
  11.  
  12. #include "transform.h"
  13. #include <math.h>
  14. #include <stdio.h>
  15.  
  16. void Tm3Translate(T, tx, ty, tz)
  17.      Transform3 T;
  18.      TmCoord tx, ty, tz;
  19. {
  20.   HPoint3 pt;
  21.   pt.x = tx;
  22.   pt.y = ty;
  23.   pt.z = tz;
  24.   pt.w = 1;
  25.   Tm3TranslateOrigin(T, &pt);
  26. }
  27.  
  28. void Tm3TranslateOrigin(T, pt)
  29.      Transform3 T;
  30.      HPoint3 *pt;
  31. {
  32.   Tm3Identity(T);
  33.   T[3][0] = pt->x / pt->w;
  34.   T[3][1] = pt->y / pt->w;
  35.   T[3][2] = pt->z / pt->w;
  36. }
  37.  
  38. /************************************************************************/
  39.  
  40. void Tm3HypTranslate(T, tx, ty, tz)
  41.      Transform T;
  42.      TmCoord tx,ty,tz;
  43. {
  44.   HPoint3 pt;
  45.   float t = sqrt( tx*tx + ty*ty + tz*tz );
  46.  
  47.   if(t > 0) {
  48.     pt.x = sinh(t) * tx / t;
  49.     pt.y = sinh(t) * ty / t;
  50.     pt.z = sinh(t) * tz / t;
  51.     pt.w = cosh(t);
  52.     Tm3HypTranslateOrigin(T, &pt);
  53.   } else {
  54.     Tm3Identity(T);
  55.   }
  56. }
  57.  
  58. static void minkowski_normalize(HPoint3 *pt)
  59. {
  60.   float f = sqrt( pt->w*pt->w  - pt->x*pt->x - pt->y*pt->y - pt->z*pt->z );
  61.   pt->x /= f;
  62.   pt->y /= f;
  63.   pt->z /= f;
  64.   pt->w /= f;
  65. }
  66.  
  67. void Tm3HypTranslateOrigin(T, pt)
  68.      Transform T;
  69.      HPoint3 *pt;
  70. {
  71.   Transform R, Rinv;
  72.   minkowski_normalize(pt);
  73.   Tm3Identity(T);
  74.   T[2][3] = T[3][2] = sqrt(pt->x*pt->x + pt->y*pt->y + pt->z*pt->z);
  75.   T[2][2] = T[3][3] = pt->w;
  76.   Tm3RotateTowardZ(R, pt);
  77.   Tm3Invert(R, Rinv);
  78.   Tm3Concat(R, T, T);
  79.   Tm3Concat(T, Rinv, T);
  80. }
  81.  
  82. /***********************************************************************/
  83.  
  84. void Tm3SphTranslate(T, tx, ty, tz)
  85.      Transform T;
  86.      TmCoord tx, ty, tz;
  87. {
  88.   HPoint3 pt;
  89.   float t = sqrt( tx*tx + ty*ty + tz*tz );
  90.  
  91.   if(t > 0) {
  92.     pt.x = sin(t) * tx / t;
  93.     pt.y = sin(t) * ty / t;
  94.     pt.z = sin(t) * tz / t;
  95.     pt.w = cos(t);
  96.     Tm3SphTranslateOrigin(T, &pt);
  97.   } else {
  98.     Tm3Identity(T);
  99.   }
  100. }
  101.  
  102. static void sph_normalize(HPoint3 *pt)
  103. {
  104.   /* the following line originally did not have sqrt; but I think it
  105.      should.  Right?  -- mbp Thu Dec 10 11:02:46 1992 */
  106.   float t = sqrt( pt->x*pt->x + pt->y*pt->y + pt->z*pt->z + pt->w*pt->w );
  107.   if(t > 0) {
  108.     pt->x /= t;
  109.     pt->y /= t;
  110.     pt->z /= t;
  111.     pt->w /= t;
  112.   }
  113. }
  114.  
  115. void Tm3SphTranslateOrigin(T, pt)
  116.      Transform T;
  117.      HPoint3 *pt;
  118. {
  119.   Transform R, Rinv;
  120.   sph_normalize(pt);
  121.   Tm3Identity(T);
  122.   T[2][3] = -(T[3][2] = sqrt(pt->x*pt->x + pt->y*pt->y + pt->z*pt->z));
  123.   T[2][2] = T[3][3] = pt->w;
  124.   Tm3RotateTowardZ(R, pt);
  125.   Tm3Invert(R, Rinv);
  126.   Tm3Concat(R, T, T);
  127.   Tm3Concat(T, Rinv, T);
  128. }
  129.  
  130. void Tm3SpaceTranslate(T, tx, ty, tz, space)
  131.      Transform3 T;
  132.      TmCoord tx, ty, tz;
  133.      int space;
  134. {
  135.   switch (TM_SPACE(space)) {
  136.   case TM_EUCLIDEAN:
  137.   default:
  138.     Tm3Translate(T, tx, ty, tz);
  139.     break;
  140.   case TM_HYPERBOLIC:
  141.     Tm3HypTranslate(T, tx, ty, tz);
  142.     break;
  143.   case TM_SPHERICAL:
  144.     Tm3SphTranslate(T, tx, ty, tz);
  145.     break;
  146.   }
  147. }
  148.  
  149. void Tm3SpaceTranslateOrigin(T, pt, space)
  150.      Transform3 T;
  151.      HPoint3 *pt;
  152.      int space;
  153. {
  154.   switch (TM_SPACE(space)) {
  155.   case TM_EUCLIDEAN:
  156.   default:
  157.     Tm3TranslateOrigin(T, pt);
  158.     break;
  159.   case TM_HYPERBOLIC:
  160.     Tm3HypTranslateOrigin(T, pt);
  161.     break;
  162.   case TM_SPHERICAL:
  163.     Tm3SphTranslateOrigin(T, pt);
  164.     break;
  165.   }
  166. }
  167.  
  168.